#ifndef SERVER_H_
#define SERVER_H_

#include <fcntl.h>
#include <string.h>
#include <stdlib.h>
#include <errno.h>
#include <stdio.h>
#include <netinet/in.h>
#include <resolv.h>
#include <sys/socket.h>
#include <arpa/inet.h>
#include <unistd.h>
#include <pthread.h>
#include "Plan.h"
#include "Agent.h"

void* SocketHandler(void*);
void* ServerInit(void*);
Agent* agent;
inline void* ServerInit(void* agents) {
	int host_port = 5000;
	struct sockaddr_in my_addr;
	//agent = ((Agent*)agents)[0];//agent 0
	int hsock;
	int * p_int;
	int err;

	socklen_t addr_size = 0;
	int* csock;
	sockaddr_in sadr;
	pthread_t thread_id = 0;

	hsock = socket(AF_INET, SOCK_STREAM, 0);
	if (hsock == -1) {
		printf("Error initializing socket %d\n", errno);
		goto FINISH;
	}

	p_int = (int*) malloc(sizeof(int));
	*p_int = 1;

	if ((setsockopt(hsock, SOL_SOCKET, SO_REUSEADDR, (char*) p_int, sizeof(int))
			== -1) || (setsockopt(hsock, SOL_SOCKET, SO_KEEPALIVE,
			(char*) p_int, sizeof(int)) == -1)) {
		printf("Error setting options %d\n", errno);
		free(p_int);
		goto FINISH;
	}
	free(p_int);

	my_addr.sin_family = AF_INET;
	my_addr.sin_port = htons(host_port);

	memset(&(my_addr.sin_zero), 0, 8);
	my_addr.sin_addr.s_addr = INADDR_ANY;

	if (bind(hsock, (sockaddr*) &my_addr, sizeof(my_addr)) == -1) {
		fprintf(
				stderr,
				"Error binding to socket, make sure nothing else is listening on this port %d\n",
				errno);
		goto FINISH;
	}
	if (listen(hsock, 10) == -1) {
		fprintf(stderr, "Error listening %d\n", errno);
		goto FINISH;
	}

	//Now lets do the server stuff

	addr_size = sizeof(sockaddr_in);

	while (true) {
		printf("waiting for agent connection\n");
		csock = (int*) malloc(sizeof(int));
		if ((*csock = accept(hsock, (sockaddr*) &sadr, &addr_size)) != -1) {
			printf("---------------------\nReceived connection from %s\n",
					inet_ntoa(sadr.sin_addr));
			pthread_create(&thread_id, 0, &SocketHandler, (void*) csock);
			pthread_detach(thread_id);
		} else {
			fprintf(stderr, "Error accepting %d\n", errno);
		}
	}

	FINISH: ;
}

inline void* SocketHandler(void* lp) {
	int *csock = (int*) lp;
	const char REPLY[12]="SERVER ECHO";

	char buffer[1024];
	int buffer_len = 1024;	//can be increased or decreased later on
	int bytecount;			//needed to check for errors

	memset(buffer, 0, buffer_len);
	if ((bytecount = recv(*csock, buffer, buffer_len, 0)) == -1) {
		fprintf(stderr, "Error receiving data %d\n", errno);
		goto FINISH;
	}
	printf("Received string \"%s\"\n", buffer);

	(*agent).interpretCommunicationCommand(buffer);

	if ((bytecount = send(*csock, REPLY, strlen(REPLY), 0)) == -1) {
		fprintf(stderr, "Error sending data %d\n", errno);
		goto FINISH;
	}

	FINISH: free(csock);
	return 0;
}
#endif
